home *** CD-ROM | disk | FTP | other *** search
/ QRZ! Ham Radio 8 / QRZ Ham Radio Callsign Database - Volume 8.iso / pc / files / dsp / 96000tar.z / 96000tar / 96000 / appb / b120.asm < prev    next >
Assembly Source File  |  1992-04-28  |  5KB  |  95 lines
  1. ; This program was originally published in the Motorola DSP96002 Users Manual
  2. ; and is provided under a DISCLAIMER OF WARRANTY available from Motorola DSP
  3. ; Operation, 6501 William Cannon Drive West, Austin, Texas 78735-8598.  For
  4. ; more information, refer to the DSP96002 Users Manual, Appendix B, DSP
  5. ; Benchmarks.
  6. ;
  7. ; B.1.20    Normalized Lattice Filter  
  8. ;                                      
  9. ;                                         NORMALIZED LATTICE FILTER 
  10. ;                          COEFFICIENT AND STATE VARIABLE STORAGE 
  11. ; 
  12. ;          r0                                  r4 
  13. ;                                              
  14. ;       
  15. ;     X: q2 k2 q1 k1 q0 k0 w3 w2 w1 w0    Y: sx s2 s1 s0 
  16. ; 
  17. ;        m0=3*N (=9, mod 10)                 m4=N  (=3, mod 4) 
  18. ; 
  19.  
  20. ;; 
  21. ;                                                  SINGLE SECTION 
  22. ; 
  23. ;                                           EQUATIONS: 
  24. ;                          
  25. ;                                          t'=t*q-k*s 
  26. ;                                          u'=t*k+s*q 
  27. ;                                          t'?t 
  28. ;                         
  29. ;                                          output=sum (w*u') 
  30. ;                            
  31. ;          
  32. ;           
  33. ;          
  34. ;
  35. ;                                       DSP56000 IMPLEMENTATION  
  36. ;                                                            Program     ICycles
  37. ;                                                            Words 
  38. ;  move       #coef,r0        ;point to coefficients 
  39. ; move       #3*N,m0         ;mod on coefficients 
  40. ; move       #state,r4       ;point to state variables 
  41. ; move       #N,m4           ;mod on filter states 
  42. ; 
  43. ; movep      y:datin,y0      ;get input sample 
  44. ; 
  45. ; move           x:(r0)+,x1           ;get first Q in table     1     1 
  46. ; do    #order,_endnlat                                         2     3 
  47. ; mpy   x1,y0,a  x:(r0)+,x0 y:(r4),y1 ;q*t, get k, get s        1     1 
  48. ; macr -x0,y1,a  b,y:(r4)+            ;q*t-k*s, save new s      1     1 
  49. ; mpy   x0,y0,b             a,y0      ;k*t, set t'              1     1 
  50. ; macr  x1,y1,b  x:(r0)+,x1           ;k*t+q*s, get next q      1     1 
  51. ;_endnlat 
  52. ; move                      b,y:(r4)+ ;sv scnd lst st           1     1 
  53. ; move                      a,y:(r4)+ ;save last state          1     1 
  54. ; clr   a                   y:(r4)+,y0 ;clr acc, get fst st     1     1 
  55. ; rep   #order                         ;do fir taps             1     2 
  56. ; mac   x1,y0,a  x:(r0)+,x1 y:(r4)+,y0                          1     1 
  57. ; macr  x1,y0,a             (r4)+      ;rnd, adj pointer        1     1 
  58. ; 
  59. ; movep a,y:datout           ;output sample 
  60. ;                                                                            ---   ---
  61. ;                                                      Totals: 13   5N+10
  62. ;                                             DSP96002 IMPLEMENTATION 
  63. ; 
  64. ;                                                          Program    ICycles
  65. ;                                                          Words 
  66.  move       #coef,r0        ;point to coefficients 
  67.  move       #3*N,m0         ;mod on coefficients 
  68.  move       #state,r4       ;point to state variables 
  69.  move       #N,m4           ;mod on filter states 
  70.  
  71.  move p     y:datin,d5.s    ;get input sample 
  72.  
  73.  move                     x:(r0)+,d6.s ;get q                ;  1     1 
  74.  do     #N,_elat                                             ;  2     3 
  75. ;      t*q       k*w+q*s     get k    get s 
  76.  fmpy d5,d6,d2  fadd.s d1,d3 x:(r0)+,d4.s y:(r4)+,d7.s       ;  1     1 
  77. ;      k*s                            save s 
  78.  fmpy.s d4,d7,d0                        d3.s,y:(r4)+         ;  1     1 
  79. ;      t*k       w*q-k*s; 
  80.  fmpy d5,d4,d1  fsub.s d0,d2                                 ;  1     1 
  81. ;      q*s         t?t'   get q 
  82.  fmpy.s d6,d7,d3             d2.s,d5.s    x:(r0)+,d6.s       ;  1     1 
  83. _elat 
  84.                 fadd.s d1,d3           ;finish last t          1     1 
  85.  move                                d3.s,y:(r4)+ ;save 2nd s  1     1 
  86.  fclr   d2                           d5.s,y:(r4)+ ;save 1st s  1     1 
  87.  fclr   d3                           y:(r4)+,d7.s ;get s       1     1 
  88.  rep   #N                                                     ; 1     2 
  89.  fmpy  d6,d7,d2 fadd.s d2,d3 x:(r0)+,d6.s y:(r4)+,d7.s  ;fir   1     1 
  90.                 fadd.s d2,d3              (r4)+   ;adj r4      1     1 
  91.  
  92.  move p  d3.s,y:datout 
  93. ;                                                            ; ---    --- 
  94. ;                                                     Totals:  14   5N+11 
  95.